• 专利附录
  • 专利说明
  • 权利要求
  • 类似技术
  • 同族专利
  • 引用文献
  • 法律状态
  • 优先权
    • 专利摘要:
    The invention relates to a device for locating a moving target (A) for a follower vehicle (B), comprising a first communication module (S1) at a first location on said follower vehicle (B) for determining a first measurement of distance (dl) between the first location and the moving target (A) at a first instant, and a second communication module (S2) at a second location on the tracking vehicle (B) to determine a second distance measurement (d2) between the second location and the moving target (A) at a second time, and a calculation module for determining a prediction of the moving of the follower vehicle between the first and second instants, and determining a location of said moving target relative to said follower vehicle from the first and second distance measurements, taking into account the prediction, so as to compensate for the displacement between the first and second instants.
    公开号:FR3048148A1
    申请号:FR1651429
    申请日:2016-02-22
    公开日:2017-08-25
    发明作者:Roland Chapuis；Jean Laneurit；Christophe Debain
    申请人:Centre National de la Recherche Scientifique CNRS；Pascal Blaise Universite；Institut National de Recherche en Sciences et Technologies Pour Lenvironnement et lAgriculture IRSTEA；
    IPC主号:
    专利说明:

    LOCATION OF A TARGET FOR FOLLOWING VEHICLE
    FIELD OF THE INVENTION The invention relates to the field of follower vehicles and more particularly to a method and a device allowing the precise location of a moving target that the follower vehicle must follow.
    BACKGROUND OF THE INVENTION
    The field of the follower vehicles is in full expansion and knows very varied fields of application.
    For example, the follower vehicle may be a motorized caddy automatically following a golf player. Another example is a carrier vehicle following a worker on an industrial site or in a factory, workshop or warehouse.
    Another example concerns the agricultural field, in which one or more motorized agricultural vehicles automatically follow a farmer.
    In some applications, the follower vehicles may follow another vehicle.
    A classic constraint for follower vehicles is to maintain a constant distance with the target tracked (pedestrian or other vehicle) and to follow its path, that is to say to be able to react to changes in speed and direction.
    Various mechanisms have been proposed to allow this monitoring. In general, this tracking can not be done without a location of the target to follow with respect to the follower vehicle. This location may include the distance and an angle relative to the direction of the follower vehicle.
    A conventional technique relies on laser rangefinders and / or cameras used either in the visible spectrum or in the infrared. A shape recognition mechanism in the images acquired by the cameras and / or the range finder is then set up to detect the target to be tracked and estimate its relative position.
    Such methods, however, are sensitive to external disturbances such as, in particular, climatic variations (rain, smoke, fog, snow, etc.), illumination changes, temperature variations (greatly disturbing infra-red cameras), dazzling, the presence of obstacles (which can break the contact between the target and the sensors), etc.
    Moreover, even in the ideal case of a perfect perception of the environment, it remains difficult to differentiate the target from other objects present in the environment.
    For example, if the target is a pedestrian, it is technically difficult to distinguish it from another pedestrian in the observed scene. The sensor that can best differentiate two pedestrians is the camera in the visible range, but this sensor is also the most sensitive to environmental conditions. For example, it can not work at night or in poor lighting. In these conditions, the rangefinders and infrared cameras give better performance, but they do not make it easy to distinguish one pedestrian from another. The rangefinder only allows to determine silhouettes "in depth" and can distinguish silhouettes only on their size or size.
    In addition, the target to be followed may be temporarily obscured by an obstacle (tree, corner of a street, other pedestrian, etc.). The target can no longer be located. Other mechanisms are based on radio or ultrasound links. This is for example the case of those disclosed in US Patent 5,810,105 or in EP application 2,590,041.
    The location is ensured by two communication modules on the follower vehicle and a module on the target. From measurements of the flight time of the information exchanged between the module on the target and each of the modules of the following vehicle, a relative location can be estimated by trilateration.
    However, these mechanisms provide insufficient localization accuracy. Indeed, if the radio connection is broken between the communication modules, in the same way as with the solutions based on cameras or range finder, the determination of the location can no longer be ensured.
    In addition, even without such a break, the accuracy is strongly impacted by the lack of synchronization between the two communication streams: the first between the pedestrian module and the first module of the vehicle and the second between the pedestrian module and the second module of the vehicle. However, as observed by the Applicant, between the communications with the first and with the second module on board the follower vehicle, the latter was able to move, so that a bias is inserted into the calculations of the trilateration. The location thus obtained lacks precision and may even lead, in some situations, to significant aberrations.
    SUMMARY OF THE INVENTION
    The object of the present invention is to provide a solution at least partially overcoming the aforementioned drawbacks. To this end, the present invention provides a method for locating a moving target by a follower vehicle, comprising determining at least a first distance measurement between said moving target and a first location on said follower vehicle, taken in one first instant, and a second distance measurement between said moving target and a second location on said follower vehicle, taken at a second instant, characterized in that said method determines a prediction of the displacement of said follower vehicle between said first and second instants and determines a location of said moving target relative to the follower vehicle from said first and second distance measurements, taking into account said forecast, so as to compensate for said displacement between said first and second instants.
    According to preferred embodiments, the invention comprises one or more of the following characteristics which can be used separately or in partial combination with one another or in total combination with one another: said prediction and said location are determined by a Kalman filter; adite displacement prediction is determined from linear velocity measurement and the orientation of the steering gear of said follower vehicle; the prediction equations of said Kalman filter, between a moment k and a moment k-1 are
    in which Qu is the covariance matrix associated with the uncertainties of proprioceptive information from said follower vehicle, such as: and
    with
    Δχ is the time between instants k and k-1. vr, k is the linear velocity of said follower vehicle at time k; δr, k is the orientation of the steering gear of said follower vehicle at time k, and L is the track of the follower vehicle. the method further comprises a step of determining a command to adapt the speed and direction of said follower vehicle to direct it according to said location location of said target n respecting a set distance.
    Another subject of the invention relates to a device for locating a moving target for a follower vehicle, comprising a first communication module at a first location on said follower vehicle to determine a first distance measurement between said first location and said target. mobile at a first instant, and a second communication module at a second location on said follower vehicle to determine a second distance measurement between said second location and said moving target at a second time, and a calculation module for determining a forecast of the moving said follower vehicle between said first and second instants, and determining a location of said moving target relative to said follower vehicle from said first and second distance measurements, taking into account said forecast, so as to compensate said displacement between said first and second moments.
    According to preferred embodiments, this device according to the invention comprises one or more of the following characteristics which can be used separately or in partial combination with one another or in total combination with one another: said calculation module determines said prediction of the movement of the follower robot and said location of the target by a Kalman filter; said calculation module determines said displacement prediction from the proprioceptive measurements of said follower vehicle.
    Another object of the invention relates to a follower vehicle comprising such a device.
    Another object of the invention relates to a system comprising a tracking vehicle as defined above and a communication module fitted to the moving target.
    System comprising a follower vehicle (B) according to the preceding claim, and a communication module equipping said moving target (A). Other features and advantages of the invention will appear on reading the following description of a preferred embodiment of the invention, given by way of example and with reference to the accompanying drawings.
    BRIEF DESCRIPTION OF THE DRAWINGS
    Figure 1 shows schematically an example of context in which the invention can be inserted.
    Figure 2 schematizes the principle of localization by trilateration.
    Figures 3a, 3b, 3c schematize different mechanisms of distance measurements.
    DETAILED DESCRIPTION OF THE INVENTION
    Figure 1 schematically illustrates the context in which the invention is inserted. The invention allows the location of a moving target A by a follower vehicle B. The moving target A is typically a human being, which may be a pedestrian or a vehicle, including a robotic vehicle. The following vehicle B is preferably a robotic vehicle, that is to say, whose control is provided by an automatic mechanism.
    The moving target A is equipped with an S3 communication module. It will be seen later that it may include more, but only one is sufficient to implement the invention in its generality.
    The follower vehicle B is equipped with at least two communication modules SI, S2, located at two distinct locations on the vehicle. It is important that these two modules be far enough apart to obtain the best possible localization results. They may for example be near the two side edges of the follower vehicle. They must be in solidarity, that is to say that their relative distance must not vary. They must be integral with the chassis of the following vehicle.
    The communication modules SI, S2, S3 are suitable for determining distance measurements d1, d2 respectively between the module SI and the module S3 and between the module S2 and the module S3.
    These communication modules can notably rely on the standardized IEEE 802.15.4a protocol. This protocol is a standard specifying that the communication modules SI, S2, S3 incorporate a physical layer capable of performing distance measurements. This protocol has two communication formats: the IRUWB (for "Impulse Radio Ultra Wide-Band" in English) and the CSSS (for "Chirp Spread Spectrum Signais".) The invention does not lie in the measurement mechanism from a distance, but, as we shall see later, in the exploitation of these distance measurements. The distance measurement can be carried out in different ways, including those included in the state of the art.
    As part of the IEEE 802.15.4a protocol, distance measurement methods are based on the principle of time of arrival ("Time of Arrival") required for a message to go from one communication module to another.
    Thus, the "Time Of Arrival" (TOA) method, called in French flight time, is a very simple method that calculates the distance between a mobile station and a base station.
    For the generality of the presentation, the following paragraphs use the terms "mobile station" and "base station", which may represent, in the context of the invention, respectively, the follower vehicle B and the target to be followed. It should be noted that the target itself may be mobile and that the terms "mobile station" and "base station" must be understood in a relative sense: the mobile station is mobile in the base station repository ( whose repository can itself be mobile with respect to the terrestrial reference system for example).
    The exposed mechanisms are illustrated by FIGS. 3a, 3b, 3c, which schematize the protocol exchanges between two stations A, B, with a view to measuring the distance between them.
    The Time of Arrival (TOA) method is illustrated in Figure 3a.
    The mobile station A sends an RFRAME message to the base station B on the date of issue te, this date being transmitted in the message. The base station receives the message and notes the acquisition date ta.
    The distance d between the base station and the mobile station is then given by the expression d - C (te-ta) where c is the speed of light. The main disadvantage is that the clocks of the two stations must be perfectly synchronized to obtain a very precise measurement. This requires a very difficult infrastructure to implement.
    To overcome the problems of clock synchronization between base stations and mobile stations, the "Two Way Time Of Arrival" method has been proposed. This is illustrated in Figure 3b. It consists of having the base station and the mobile station communicate as follows:
    The base station A sends a RFRrame request to a mobile station B and records the date of transmission of that message,
    The mobile station responds to the request sending the RFRrame_rep message to the base station,
    The base station receives the response message and records the date of receipt ta.
    The base station A calculates the time elapsed during this exchange by the expression Tr = te-ta, and determines the distance d which separates the base station from the mobile station by d = c.Tr / 2
    The base and mobile stations are therefore both transmitters and receivers. The time Tr being measured by the base station A, there is no need to synchronize their clocks. Nevertheless, the response of the mobile station can not be immediate. Indeed, it must decode the request message sent by the base station, create a response message and finally send it. This process introduces a delay TBa and biases the distance measurement. For example, an error of a few nanoseconds introduces errors of the order of the decimetre. It is therefore important to be able to estimate this delay very precisely.
    It is possible to use a more elaborate technique to obtain the estimate of Tfa and thus obtain a more precise measurement of the distance.
    This time the dialogue between the base station and the mobile station is as follows:
    The base station A sends a request RFRramereq to the mobile station B and records the date of transmission of the last byte of the SFD ("Start Frame Delimeter") of the message RFRrame req, the mobile station B responds to the request sending the message RFRramerep at the base station, in parallel it launches a counter as soon as the last byte of the SFD of the message RFRrame rep is read and stops it when the last byte of the SFD of the message RFRrame rep is sent;
    The base station receives the response message and records the receipt date of the last octet of the SFD of the RFRramerep message,
    The mobile station sends a second message to the base station containing the value of the estimated T A using the counter,
    The base station receives the message containing the estimate of the delay T1,
    The base station sends an acknowledgment to the mobile station.
    This time, it is possible to obtain a more precise distance measurement by calculating:
    A major source of error in the TW-TOA method is the clock frequency offset between the base station and the mobile station. The clocks embedded in these modules use quartz that do not work at exactly the same frequency. Thus delays or "advances" appear in the measurement of flight time which, multiplied by the speed of light, can introduce substantial errors in the measurement of distance.
    The "Symmetry Double Sides Two Way Time Of Arrival" method (SDS-TW-ToA) solves this problem. Such a technique is illustrated in Figure 3c. The idea is this time also to estimate the time necessary for the base station to decode the RFRAMErep message from the mobile station and to re-transmit a second RFRAMEreq message to the mobile station. Thus the distance measurement dsDS is as follows:
    To show the contribution of this method, one defines the errors of frequencies eA and ee of the clocks embedded in the base station and in the mobile station, such as: and
    where RfA and Nfs. represent respectively the real and nominal frequencies of each of the clocks. By introducing them into the preceding equations, we obtain
    As part of the pedestrian tracking, the distance measurement is a few tens of meters at most, Tr will not exceed 100 nanoseconds. On the other hand, the time Tta needed to process the request message and respond to it is of the order of a millisecond. This means that the transmission time is well below the data processing time which accounts for most of the distance measurement error:
    We can therefore see that the error due to the frequency shift of the clocks is compensated with the SDS-TW-TOA method if
    According to the invention, the communication modules SI, S2, S3 can implement such distance measuring mechanisms. Concretely, these mechanisms can be implemented using communication modules available on the market and that the method and the device according to the invention can use.
    Such modules available on the market may be those of the Decawave company, and more particularly the DW1000 sensor. This sensor complies with the previously mentioned IEEE 802.15.4a communication protocol and operates in a frequency range from 3.5 GHz to 6.5 GHz with a bandwidth of 1 GHz. It allows measurement of distance with a precision of 10 cm. This sensor has among other advantages those of having a relatively low cost and being of small size, for example 23 mm x 13 mm for the model DWM1000.
    Figure 2 schematizes the principle of localization by trilateration.
    The problem to be solved is to locate the communication module S3 with coordinates (x, y) by knowing the locations of the communication modules S1 and S2, respectively of coordinates (x1, y1) and (x2, y2). and the measured distances d1, d2 between the communication module S3 and, respectively, the communication modules S1 and S2.
    Since the position of the module S3 is the point of intersection between two circles centered on each of the modules S1, S2 and of radius di and d2, this problem can very easily be solved analytically.
    The position of the module S3 with respect to that of the module SI is then:
    Either: and
    and
    The position of the S3 module in the "world" repository being:
    There are of course two solutions to this problem, the sign of the ordinate must be determined either by a constraint of the user or by adding a third communication module on the follower vehicle.
    Thus, theoretically it is possible to estimate the location of the S3 communication module in all circumstances.
    However, in practice, because of measurement noises, it turns out that under certain circumstances there is no intersection between the two circles and therefore no solution to the problem of location.
    In addition, measurement noise introduces very important discontinuities over time. Indeed, measurement noise introduces large variations in the localization results, especially on the measurement of heading. These variations are abrupt, hence the discontinuities, but the notion of discontinuity can be omitted. To give an example, in the context of experimental tests carried out by the applicant, when the vehicles are static, the estimate of the heading can vary by more or less 5 ° from one measurement to another because of the noise of measurements. on the distances. The Kalman filter implemented by one embodiment of the invention alleviates this problem while providing an original solution to synchronization problems.
    Moreover, and most importantly, the distance measurements d1, d2 are not provided synchronously, whereas the mechanisms described above assume synchronization of the measurements. As we will see later, this phenomenon further magnifies the errors in the course estimation. In general, it is difficult to provide a synchronization of the message flows transmitting the distance measurements, but in addition the communication module S3 generally has a communication interface that allows it to communicate only alternatively with the modules. SI, S2 communication. In other words, the distance measurements d1, d2 are necessarily not synchronized.
    For example, the module S3 of the moving target communicates with a first module SI of the follower vehicle for a certain duration, for example 5 ms. It is also possible to set a measurement frequency at 50 Hz. In such a situation, the measurements are spaced at least 20 ms apart.
    However, the follower vehicle is mobile and therefore between the time t1 at which the distance measurement dl is determined and the time t2 at which the distance measurement d2 is determined, it will have moved by a distance determined by the speed of the vehicle, its direction and the interstage period.
    Consequently, the distance measurements d1 and d2 do not correspond to the same position of the follower vehicle and the trilateration methods can no longer function satisfactorily.
    The method according to the invention provides steps for: determining at least a first distance measurement d1 between the moving target A and a first location in (or on) the tracking vehicle B, typically corresponding to a first communication module SI taken at a first instant tl, determining a second distance measurement d2 between the moving target A and a second location S2 in (or on) the tracking vehicle B, typically corresponding to a second communication module S2, taken in one second instant t2, determining a prediction of the displacement of the follower vehicle between the first and second instants, t1, t2 and determining a location of the moving target B relative to the follower vehicle A from these first and second measurements of distance, dl, d2, taking into account the displacement prediction, so as to compensate the movement of the follower vehicle between the first and second instants.
    The determination of the displacement can typically be made from the linear velocity measurement of the follower vehicle and the orientation of its steering gear. Preferably, these measurements are provided by the control bodies of the follower vehicle in particular by the proprioceptive sensors on board the latter.
    Proprioceptive sensors or proprioception sensors are the measurement sensors on the state of the vehicle itself. They oppose sensors on external information. An example of a proprioceptive sensor is a speed sensor. This term is commonly understood by those skilled in the art as evidenced by the page wikipedia devoted to robotics: https://en.wikipedia.org/wiki/Autonomous_robot
    Thus, by providing the location of the follower vehicle, the method according to the invention can take into account its estimated displacement in order to compensate for it. The measurement data d1, d2 can then be used validly, and accurate despite their asynchronism. The same is obviously true if more than two measurement data are provided.
    Various methods can be implemented to take into account the asynchrony of distance measurements as well as the accuracy of data d1 and d2. These methods use filtering techniques whose characteristics make it possible to integrate: 1) the asynchronism of the data coming from the beacons 2) the displacement of the vehicle between the times t1 and t2 3) the uncertainty of movement of the vehicle between the time t1 and t2 4) the uncertainty associated with measurements dl and d2
    Among the most popular filtering techniques, Kalman filters and particulate filters are often the most effective, but others would be quite applicable if they incorporate the features mentioned above.
    According to a preferred embodiment, a Kalman filter is used to determine the displacement prediction and the location of the moving target relative to the follower vehicle. This Kalman filter makes it possible to infer and filter the location at any time.
    The state vector of the Kalman filter represents the parameters that one wants to estimate. In the context of the invention, the state vector Xk of the Kalman filter reflects the position (x, y) of the moving target A at time k such that
    By construction, the Kalman filter also estimates the accuracy of the estimate at all times. This is represented by the covariance matrix Qk.
    Knowing that the distance measurements between the moving target A and the follower vehicle B are asynchronous, one after the other, each measurement dn, k is compared with its measurement a priori dnk / ki and the location of the moving target is updated according to their difference. With each new distance measurement from the communication module Sn (with n = 1 or n = 2, in the case of two modules), the update equation of the Kalman filter at time k is as follows:
    wherein xn and yn are the coordinates of the location of the location of the communication module Sn on the follower vehicle.
    A posteriori update of the state is performed by the traditional Kalman filter equations:
    where ad is the standard deviation for distance measurements. The Jacobian of the observation function is described by:
    Experimentally, it can be shown that, under certain circumstances, the Kalman filter may consider more likely locations with a negative ordinate than those with a positive ordinate. To overcome this problem, we can implement a constrained estimation, in order to impose that the ordinate of the solutions found is always positive: yk / ki> Vn, where yn is the ordinate of the modules Si, S2 of the follower vehicle . This assumption implies that the repository is chosen so that the two modules Si, S2 are on a straight line parallel to the x axis.
    There are many methods to apply such a constraint in a Kalman filter. As examples, mention can be made of those described in Simon Simon's papers "Kalman filtering with State constraints: a survey of linear and nonlinear algorithms" in IET Contril Theory and applications, 1303-1318, 2010, and " Constrained Kalman filtering via density function truncation for turbofan engine health assessment "by Dan Simon and Donald L. Simon, in Int. J. Systems Science, 41 (2), 159-171, 2010.
    In order to use the Kalman filter technology for locating the target relative to the follower vehicle, we need to define the following new variables: (xi, y;) is the tracking vehicle location in the world repository; ΘΊ is the orientation of the follower vehicle in the world reference system; (x;, y;) is the location of the target in the world repository; { p, ÿp) is the location of the target in the reference frame of the follower vehicle. We can define this frame centered on the middle of the rear axle of the vehicle, for example.
    The kinematic model of the follower vehicle must then be defined. An example of such a kinematic model can be:
    wherein vr is the linear velocity of the follower vehicle; ôr is the direction of the steering gear, and, L is the track of the follower vehicle.
    The distance between the right and left wheels of the same axle is called "track".
    It is then possible to define the simple dynamic model, called Ackermann model:
    in which
    Δτ is the time elapsed between the instants k and k-1, that is to say the sampling period.
    The equations above describe the motion of the follower vehicle in the world. Now, our problem is to know the displacement of the target in the reference of the following vehicle.
    We define (xrp, yrp) k the location of the target in the reference frame of the follower vehicle at time k. It is assumed for the moment that the target is stationary. At time k + 1, the location of the target in the reference frame of the follower vehicle is given by the following equations:
    Using the previous system of equations, we obtain:
    where R (Ae) is a 2D rotation matrix, a function of the angle Δθ.
    However, of course, the target can be mobile, and between two instants it can move in the repository of the world.
    We can write:
    and injecting it into the preceding equation in order to obtain the equation describing the location of a moving target with respect to a follower vehicle:
    where vxv follows a normal two-dimensional centered law A {o, Qxy) whose covariance matrix Qxy is defined by the equation
    with shout the standard deviation of the displacement that can be made by the target in one second, and ΔΓ the elapsed time (in seconds) between the instants k and k + 1.
    Considering now that the location reference is that of the follower vehicle, it can be defined that the location (xrp, yrp) is equivalent to the location (x, y) previously used.
    It is then possible to estimate the location of the target using the constrained Kalman filter using the equation above.
    The prediction equations of the Kalman filter thus defined become:
    where Qu is the covariance matrix associated with the uncertainties of proprioceptive information from the follower vehicle, such as:
    and
    with cry and σδ given by the characteristics of the vehicle odometric sensors. These quantities are therefore to be determined for each vehicle.
    Knowing the location of the target with respect to which the vehicle is to be enslaved, it is possible to determine a command to adapt the speed and direction of the following vehicle. It is also possible to impose a set distance between the follower vehicle and the target.
    Different mechanisms are possible for exploiting the location of the target determined by the method according to the invention, and making it possible to define given behaviors of the follower vehicle.
    According to a particular implementation, a command is determined so that the follower vehicle is directed towards the target while respecting an inter-distance reference pc.
    In the case of a follower vehicle having a steering train and a propulsion train, the control vector is composed of the speed at the center of the rear axle vr and the orientation of the steering gear δΓ. Consider the location (p, Θ) of the target to follow in a polar coordinate system such as:
    This describes respectively the inter-distance measured between the follower vehicle and the target, as well as the orientation that the follower vehicle must follow to come behind the target. In order for the vehicle to follow the target, it is necessary to find the control vector which ensures that p tends to pc and that Θ tends to 0. The problem is generally treated separately. The heading of the following vehicle can be corrected using a proportional corrector:
    where Kpe is the proportional gain of the corrector. We can regulate the inter-distance between the vehicle B and the target A with the aid of an integral proportional corrector:
    in which Kpp and Kip are respectively the proportional and integral gains of the corrector. The equation δr, k = Kpe0k shows that in order to correct the heading of the vehicle, it is sufficient to orient the wheels of the steering gear of the vehicle towards the target. The preceding equation shows that an integral action is necessary to regulate the linear speed of the vehicle so that the inter-distance is always respected, that is to say that the quantity pk -pc tends towards 0.
    Note that if the target is moving towards the vehicle, the quantity pk - pc becomes negative and will cause the vehicle to retreat because the speed vr, k will also become negative.
    It may be desirable to prevent the vehicle from reversing, in particular for safety reasons. In which case, it is possible, according to one embodiment, to introduce the following constraint:
    where ar, k is the standard deviation on the distance measurement pk separating the vehicle and the target such that:
    with
    And Pk is the matrix provided at the instant k by the target location module. This matrix can be deduced a posteriori or a priori depending on whether the command is performed at the same time as updating the Kalman filter or not.
    The foregoing description relates to an implementation in which the follower vehicle has 2 communication modules Si, S2, but it is also possible to consider more than 2 communication modules.
    Of course, the present invention is not limited to the examples and to the embodiment described and shown, but it is capable of numerous variants accessible to those skilled in the art.
    权利要求:
    Claims (10)
    [1" id="c-fr-0001]
    A method of locating a moving target (A) by a follower vehicle (B), comprising determining at least a first distance measurement (dl) between said moving target (A) and a first location (SI) on said follower vehicle, taken at a first instant, and a second distance measurement (d2) between said moving target (A) and a second location (S2) on said follower vehicle, taken at a second instant, characterized in that said method determines a prediction of the displacement of said follower vehicle between said first and second instants, and determines a location of said moving target relative to the follower vehicle from said first and second distance measurements, taking into account said forecast, so compensating for said displacement between said first and second instants.
    [2" id="c-fr-0002]
    2. Method according to the preceding claim, wherein said prediction and said location are determined by a Kalman filter.
    [3" id="c-fr-0003]
    3. Method according to the preceding claim, wherein said displacement prediction is determined from linear velocity measurement and Torientation of the steering gear of said follower vehicle.
    [4" id="c-fr-0004]
    4. Method according to the preceding claim, wherein the prediction equations of said Kalman filter, between a moment k and a moment k-1 are

    where Q "is the covariance matrix associated with the uncertainties of the proprioceptive information from said follower vehicle, such as:

    and with



    Δτ is the time between instants k and k-1. vr, k is the linear velocity of said follower vehicle at time k; δr, k is the orientation of the steering gear of said follower vehicle at time k, and L is the track of the follower vehicle.
    [5" id="c-fr-0005]
    5. Method according to one of the preceding claims, further comprising a step of determining a command to adapt the speed and direction of said follower vehicle (B) in order to direct it according to said location location of said target ( A) respecting a set distance.
    [6" id="c-fr-0006]
    6. Device for locating a moving target (A) for a follower vehicle (B), comprising a first communication module (SI) at a first location on said follower vehicle (B) to determine a first distance measurement (dl ) between said first location and said moving target (A) at a first instant, and a second communication module (S2) at a second location on said tracking vehicle (B) to determine a second distance measurement (d2) between said second location and said moving target (A) at a second time, and a calculation module for determining a prediction of the displacement of said follower vehicle between said first and second instants, and determining a location of said moving target with respect to said follower vehicle from said first and second distance measurements, taking into account said prediction, so as to compensate for said displacement between said first and second instants.
    [7" id="c-fr-0007]
    7. Location device according to the preceding claim, wherein said calculation module determines said prediction of the movement of the follower robot and said location of the target by a Kalman filter.
    [8" id="c-fr-0008]
    8. Location device according to the preceding claim, wherein said calculation module determines said displacement forecast from the proprioceptive measurements of said follower vehicle.
    [9" id="c-fr-0009]
    9. Tracking vehicle (B) comprising a device according to one of claims 6 to 8.
    [10" id="c-fr-0010]
    10. System comprising a follower vehicle (B) according to the preceding claim, and a communication module equipping said moving target (A).
    类似技术:
    公开号 | 公开日 | 专利标题
    FR3048148A1|2017-08-25|LOCATION OF A TARGET FOR FOLLOWING VEHICLE
    US10671083B2|2020-06-02|Neural network architecture system for deep odometry assisted by static scene optical flow
    KR102210271B1|2021-02-01|Technologies for vehicle positioning
    US20190080470A1|2019-03-14|Output of a neural network method for deep odometry assisted by static scene optical flow
    EP3126864B1|2020-07-15|Method for geolocating the environment of a carrier
    WO2010020625A1|2010-02-25|Method and device for remotely controlling a camera on board a mobile station
    WO2015058986A1|2015-04-30|Method for indoor and outdoor positioning and portable device implementing such a method
    WO2008040896A2|2008-04-10|Method of locating a vehicle
    EP3388914A1|2018-10-17|Target tracking method performed by a drone, related computer program, electronic system and drone
    EP3152593B1|2020-07-22|Device for detecting an obstacle by means of intersecting planes and detection method using such a device
    EP3152592A1|2017-04-12|Device for detection of obstacles in a horizontal plane and detection method implementing such a device
    US10268205B2|2019-04-23|Training and testing of a neural network method for deep odometry assisted by static scene optical flow
    EP2626725B1|2015-11-18|Method for determining a confidence indicator relating to the path taken by a mobile
    FR3064072A1|2018-09-21|METHOD AND DEVICE FOR FILTERING NAVIGATION SIGNALS RECEIVED FROM SATELLITES
    FR3075949A1|2019-06-28|METHOD FOR DETERMINING ANTICIPATION DISTANCE FROM THE TRACK OF A MOTOR VEHICLE
    FR3064073A1|2018-09-21|METHOD AND DEVICE FOR DETERMINING A POSITION
    FR3077549A1|2019-08-09|METHOD FOR DETERMINING THE TRACK OF A MOTOR VEHICLE IN ABSENCE OF GROUND MARKING
    WO2021181048A1|2021-09-16|Method and device for dating camera images
    FR3100895A1|2021-03-19|Swarm drone automatic positioning method and system
    WO2020201243A1|2020-10-08|Method for updating a road map based on a network of contributors
    WO2019201845A1|2019-10-24|Device for synchronizing a primary position of a mobile object with a secondary position
    FR3041766A1|2017-03-31|PASSIVE LOCALIZATION METHOD OF ELECTROMAGNETIC GROUND EMITTERS, USE, AND DEVICE THEREOF
    FR3037466A1|2016-12-16|METHOD AND SYSTEM FOR AUTOMATICALLY POINTING A MOBILE UNIT
    EP3227716A1|2017-10-11|Method of determining a trajectory mapping by passive pathway of a mobile source by a method of inverse triangulation
    FR2888941A1|2007-01-26|MOBILE EQUIPMENT, METHOD AND SYSTEM FOR POSITIONING A MOBILE EQUIPMENT
    同族专利:
    公开号 | 公开日
    FR3048148B1|2018-12-07|
    WO2017144808A1|2017-08-31|
    EP3420373A1|2019-01-02|
    US20190137617A1|2019-05-09|
    引用文献:
    公开号 | 申请日 | 公开日 | 申请人 | 专利标题
    US5810105A|1995-03-15|1998-09-22|Technologietransfer-Anstalt Tetra|Ultrasonic tracking control for an automotive vehicle|
    US6327219B1|1999-09-29|2001-12-04|Vi&T Group|Method and system for directing a following device toward a movable object|
    EP1708065A2|2005-03-31|2006-10-04|Deere & Company|Method and system for following a lead vehicle|
    EP2590041A2|2011-11-07|2013-05-08|Willem-Dirk Hendrik Udo|Target-following vehicle|FR3094256A1|2019-03-29|2020-10-02|Norcan|improved motorized robot|
    EP3865967A1|2020-02-11|2021-08-18|Cart Technology, S.L.|Trolley-based following system|
    RU2719083C1|2016-09-21|2020-04-17|Ниссан Мотор Ко., Лтд.|Method for controlling movement and device for controlling movement of vehicle|
    KR102038317B1|2017-11-21|2019-10-30|주식회사 티티엔지|Golf cart system capable of autonomous travel based on accurate position information and golf cart control method using the system|
    CN112017171B|2020-08-27|2021-10-26|四川云从天府人工智能科技有限公司|Image processing index evaluation method, system, equipment and medium|
    法律状态:
    2016-12-13| PLFP| Fee payment|Year of fee payment: 2 |
    2017-08-25| PLSC| Search report ready|Effective date: 20170825 |
    2017-12-08| PLFP| Fee payment|Year of fee payment: 3 |
    2020-03-02| PLFP| Fee payment|Year of fee payment: 5 |
    2020-05-01| TQ| Partial transmission of property|Owner name: UNIVERSITE BLAISE PASCAL, FR Effective date: 20200326 Owner name: CENTRE NATIONAL DE LA RECHERCHE SCIENTIFIQUE -, FR Effective date: 20200326 Owner name: INSTITUT NATIONAL DE RECHERCHE POUR L'AGRICULT, FR Effective date: 20200326 |
    2021-02-25| PLFP| Fee payment|Year of fee payment: 6 |
    优先权:
    申请号 | 申请日 | 专利标题
    FR1651429|2016-02-22|
    FR1651429A|FR3048148B1|2016-02-22|2016-02-22|LOCATION OF A TARGET FOR FOLLOWING VEHICLE|FR1651429A| FR3048148B1|2016-02-22|2016-02-22|LOCATION OF A TARGET FOR FOLLOWING VEHICLE|
    US16/078,775| US20190137617A1|2016-02-22|2017-02-21|Location of a target by a tracking vehicle|
    EP17710337.1A| EP3420373A1|2016-02-22|2017-02-21|Location of a target by a tracking vehicle|
    PCT/FR2017/050381| WO2017144808A1|2016-02-22|2017-02-21|Location of a target by a tracking vehicle|
    [返回顶部]